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Abstract — In this paper, the controller design for path¬ 
following using input-output feedback linearization 
method for the automatic guided vehicle with 
uncertainties and external disturbances is proposed. The 
dynamic model of the system with uncertainties and 
external disturbances is presented. An auxiliary control 
input vector is designed using input-output linearization 
technique. The auxiliary control input vector transforms 
the overall system into two linearized subsystems of the 
position control subsystem and velocity control 
subsystem. Based on the two linearized subsystems, a new 
control law vector for path-following is designed. The 
new control input vector for path-following guarantees 
that the tracking errors vector converges exponentially to 
zero. In addition, a scheme of measuring the errors for 
experiment by a USB camera is also described. The 
simulation and experimental results are presented to 
illustrate effectiveness of the proposed controller. 
Keywords—Automatic Guided Vehicle (AGV), Input- 
Output Feedback Linearization (IOFL), Path-Following 
Controller (PFC). 

I. INTRODUCTION 

Generally, AGV have been used extensively in several 
industrial and service fields such as transportation, 
military, security, space, household, office automation 
and scientific laboratory systems. 

Recently, many research results of AGV have been 
implemented via feedback linearization. In most 
researches, AGV was considered as a mobile robot. The 
control problems of a mobile robot include trajectory 
tracking, to control the robot to follow a desired trajectory 
starting from a given initial configuration, and point 
stabilization, to drive a robot from a given initial point to 
target point. Point stabilization of mobile robot via state - 
space exact feedback linearization based on dynamic 
extension approach was proposed in [1]. The objective of 
this controller is to stabilize a mobile robot at a given 
target point in the polar coordinate. In [2, 3], feedback 
linearization technique was also used for trajectory 
tracking and point stabilization of mobile robot systems. 


All the above controllers show that they have a good 
performances and the tracking errors to go to zero in both 
case but consider only the kinematic model. 

Many control schemes have been proposed to deal with 
the mobile robot control problem including the 
mechanical system dynamic. In [4], Kalman-based active 
observer controller (AOB) was applied to the path 
following. It guarantees the overall system’s stability 
even in the presence of uncertainries. The performance of 
the proposed control algorithm is verified via simulation 
results but consider only in discrete model. Jeon et al. [5] 
also proposed the feedback linearization controller based 
on dynamic model for lattice type welding with seam 
tracking sensor that shows a good results in simulation 
but did not consider uncertainties and external 
disturbances. Control of welding mobile robot or mobile 
robot for tracking trajectory considering uncertainties and 
external disturbances using sliding mode control with 
good tracking performance are presented in [6]-[9]. 

This paper proposed the path-following controller design 
method using input-output feedback linearization 
technique for the automatic guided vehicle with 
uncertainties and external disturbances. The dynamic 
model of the system with uncertainties and external 
disturbances is presented. An auxiliary control input 
vector is designed using input-output linearization 
technique. The auxiliary control input vector transforms 
the overall system into two linearized subsystems of the 
position control subsystem and velocity control 
subsystem. Based on the two linearized subsystems, a 
new control input vector for path-following is designed. 
The new control input vector for path-following 
guarantees that the tracking errors vector converges 
exponentially to zero. In addition, a scheme of measuring 
the errors for experiment by a USB camera is also 
described. The simulation and experimental results are 
presented to illustrate effectiveness of the proposed 
controller. 
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II. SYSTEM DESCRIPTION AND MODELING 
OF AGV 

1. System description 

Fig. 1 shows configuration of the AGV. It consists of 
frame, two driving wheels, two passive casters, one 
rotation wheel, control system and USB camera etc. Fig. 
2 shows the configuration for geometric model of the 
AGV. The two driving wheels are independently driven 
by two dc motors to achieve a desired motion and 
orientation. The two driving wheels have the same radius 
denoted by r and are separated by 2b . The center of 
mass of the AGV is located at C; point P is the 
intersection of a straight line passing through the middle 
of the vehicle and an axis of the two driving wheels and is 
rotation center of AGV. The distance between the two 
points is denoted by d . The body length of the AGV is 
/. P a is a tracking point attached to the platform with 
coordinates (x a ,y a ) and is placed in the X 0 axis at a 
distance L a (look-ahead distance) of P . A USB camera 
is located at the tracking point P a . The posture of the 
AGV in the global coordinate frame OXY is specified by 
the vector q = [x p , y p , (f>] T where x p and y p are the 

coordinate of point P in the global coordinate frame and 
tj) is the orientation of the local frame PXqYq attached on 

the AGV platform. The AGV is modeled under the 
assumptions in [5, 6]. 




Fig. 2: Configuration for geometric model of the AGV 


2. Kinematic Modeling 

Consider a robot mobile system having an ^-dimensional 
configuration space with a generalized coordinate vector 

q e and the robot is subjected to m independent 
constraints of the following form [4-[6]: 

A(q)q = 0 (1) 


where A(q) e 9U xn is a full rank matrix associated with 
the nonholonomic constraints. 

S(q) g 9U x(n_m) is defined to be a full rank matrix formed 
by a set of smooth and linearly independent vector fields, 
spanning the null space of A(q). Thus, the result of 
multiplication of these matrices can be written as follows: 


A(q)S(q) = 0 ( 2 ) 

Supposing pure rolling conditions with no slip of the 
wheels, the following kinematics constraints (m - 3) can 
be written: 

x p sintj) - y p cos(j) - 0 (3) 

Jc p cos<f> + y p sirup + b<p = rO m (4) 

x p cos<p + y p sirup -b<p = r6 Iw (5) 


From Eqs. (3)-(5), the constraint matrix in Eq. (1) can be 
obtained as 


A(q) = 


sintj) 

cost/) 

COS(j) 


-cost/) 

sintj) 

sintj) 


0 

b 

-b 


0 

-r 

0 


0 

0 

-r 


( 6 ) 


and q = [a 


y tb 6 

J p t r 



denote configuration of 


the system (n - 5) . 

The null space matrix S(q) of A(q) that satisfies Eq. (2) 
is 


S(q) = 


cb cos tj) 
cb sin tj 
c 


1 

0 


cb cos tj) 
cb sin tj) 
-c 
0 
1 


(7) 


where the constant c-(r! 2b) . 

From the constraint Eq. (1), q must be in the null space 
of A(q).It follows that q e span {Sj(q), s 2 (q)}, and that 
there exists a smooth angular velocity vector 

z = Kw ®/w f = IA 4, J G 9T n ~ m)xl such that 


q = S(q)z(t) ( 8 ) 

where co^, o lw are angular velocities of the right and 
the left wheels, respectively. 

3. Dynamic Modeling 

Lagrange equations of motion for the nonholonomic 
mobile robot system are given by 
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d_ 

dt 


dL A 


dq, 


\^k J 


8L /V; 


(9) 


where A . are Lagrange multipliers associated with j th 
(j = 1,...,3) constraint equation, a jk is k th (k = 1,...,5) 
coefficient of k th constraint equation, q k is generalized 
coordiate, f k is generalized force, and L is a Lagrangian. 
Lagrangian is defined as: 




in 
~2 

(I+md 2 ) 


d> 2 +2^-d> 2 + I -^e 1 +L#2 

v 2 v 2 ™ 2 t* 


( 10 ) 


where M(q) = 


C(q,q) = 0 5x5 , D(q) 


m 0 0 0 0 

0 m 0 0 0 

0 0 10 0 
0 0 0 I w 0 

0 0 0 0 /,„ 

0 O' 

0 0 

0 0 , T : 
1 0 

0 1 


M(q) g ${ nxn is the inertia matrix; C(q,q) e ST* is the 


centripetal and Coriolis forces matrix; D(q) c S .R 


nx(n-m) 


IS 


where m c is the mass of the robot platform and m w is the 
mass of each driving wheel plus the rotor of its motor; I c 
is the inertia of the robot platform about a vertical axis 
through the center of mass C ; I w is the inertia of each 
wheel with the motor’s rotor about the wheel axis; and 
I m is the inertia about a defined axis in the plan of the 
wheel (perpendicular to the wheel axis); (i^, and 
(x lw , y lw ) are linear velocities of right wheel and left 
wheel in x and y axes, respectively. 

Defining I = I c + 2I m + 2 m w b 2 +m c d 2 and m — rn + 2 m w , 
Eq. (10) can be rewritten as: 



According to Eqs. (6), (9) and (11), the dynamic model is 
written as: 

mx p = sin (p - (X 2 + X 3 ) cos (p 


the input transformation matrix; A T (q) g W m is a matrix 
of nonholonomic constraints; t e 5f (n_m)xl i s the control 
input vector; X e 9? mxl is the vector of constraint forces. 

4. State Space Realization 
Differentiating Eq. (8) with respect to t , substituting in 
Eq. (13), multiplying the both sides of the equation by 
S T and noticing that (S T A T )L = 0 from Eq. (2) and 
S t D = I (n _ m)x(n _ w) , the following form can be obtained: 

S t MSz + S t (MS + CS)z = x (14) 

The real dynamic equation of AGV with the external 
disturbance can be derived from Eq. (14) 

S t MSz + S T (MS + CS)z + x d = x 

<^>Mz + Cz + T d =T (15) 

where M = S T MS e 9? (n “ m)x(n “ m) , 

C = S T (MS + CS) e « (n “ m)x(n “ w) . 


my p = \ cos (p - (X 2 + X 3 ) sin (p (12) 

H = -( 4 - \)b 
I Jo rw — 

I A*= T l W + A 3 r 

where A 3 are Lagrange multipliers which can 

effectively be eliminated by the below procedure. z rw and 
r lw are the torques of the right and left wheels, 
respectively. 

The equations in Eq. (12) can be expressed in matrix 
form, such as: 

M(q)q + C(q,q)q = D(q)x- A T (q)L (13) 


It is assumed that the disturbance vector can be expressed 
as a multiplier of matrix M as follows [6]: 

T d = Mf d G 9f (n - m)xl , G 9f (n “ m)xl . (16) 

f, = IL fu f , | fu I ^ I f 2d | * (17) 

where f™ and f™ d are upper bounds of disturbances. 

The state variable vector is defined as 

x = [q z] T (18) 

= [*„ y P t a,* 

Based on Eqs. (8), (15), (16) and (18), the dynamic 
system of AGV can be expressed in the following state- 
space form: 


x = 


Sz 


^ nx(n-m) 

M' 1 


T + 


where f 2 = -MCz e 


(19) 
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Assuming that the number of system inputs r>(n — m ), 
and that M' 1 has rank ( n-m ), the following control 
input vector can be obtained. 

T = M[u-f 2 H-fJ (20) 

where u = zg 9J (n ~ m)xl i s an auxiliary control input 
vector. 

From Eq. (20), Eq. (19) can be rewritten to the form 


x = 


S(q)z 


0 


nx(n-m) 


(n-m)x(n-m) 


u=f(x) + g(x)u 


( 21 ) 


where 


f(x) = 


g(x) = 


S(q)z 

0. . 

0 


■SR' 


(2n-m)xl 


^(2 n-m)x(n-m) 

"■(n-m)x(n-m) _ 

III. CONTROLLER DESIGN FOR PATH- 
FOLLWING USING INPUT-OUTPUT 
FEEDBACK LINEARIZATION METHOD 

Consider the following MIMO (multi-input/multi-output) 
nonlinear system. 

x = f(x) + g(x)u (22) 

y = h(x) (23) 

where xe$R (2n-m)xl is the state vector, ue$R (n_m)xl is 
auxiliary control input vector, y e 9f (n_m)xl is the output 
vector. f(x) e iR (2n ' m)xl and g( x ) e iH (2n “ m)x(n_m) are 
smooth vector fields, and h(x) e $R (n-m)xl are smooth 
functions on the state space. 

The objective of this part is to design a path-following 
controller that allows the AGV to follow a desired path in 
the Cartesian space starting from a given initial 
configuration with a desired linear velocity. 

Let the output equation be represented by a vector y as 
follows: 

y = [.>i y 2 f = fa(q) fh(z )f (24) 

where q) is the shortest distance from the tracking 
point P a on the AGV platform to the desired path, h 2 ( z) 
is linear velocity v p of point P of AGV along the X 0 
axis. 

In case of a straight line described by Ax+By + C = 0, 
the output equations are given as follows: 

AX a + By 


y l (q)=h 1 (x a ,y a ,0) = 
and y 2 = h 2 (z) = x cos $ 


-Ja 2 + B 1 


•+y p sm <t 




(25) 


(26) 


where (x a ,y a ) is the coordinates of the point P a \ 
(x p ,y p ,</>) is related to the state variables by the 
following equations. 


X a — x p + L a cos (f 
y a =y P +L a sin</> 


(27) 


Now, a path-following controller can be designed based 
on the feedback linearization technique. To get the 
decoupling matrix for feedback linearization of the above 
output equations, the output equations are differentiated 
until the input terms appear in the differentiated output 
equations as follows: 


3) = = J h i(q)S(q)z 

oq 


(28) 


, 9(J hl S)... 






5q 

_ 9(J U S), 


5q 


qz + J hl (q)S(q)z 
qz + J hl (q)S(q)u 


y 2 =J h2 (z)z = J h2 (z)u 

where J hl (q) = ^ e ^ lx " and J h2 (z) = ^ e are 


(29) 

(30) 


0q dz 

Jacobian matrices. 

So the decoupling matrix <P d for the above equations is 
given as follows: 




^di(q) 


'j hl (q)S(q )' 

_q> d2 (z)_ 


J h2 (z) 


iSR 


2 x(n-m) 


(31) 


where the Jacobian matrices in Eq. (31) for the straight 
line are calculated from Eqs. (25) and (26) as follows: 
d\ 


J„i(q) = 


dq 


si A 2 + B 2 


A 

B 

BL a cos ^ - AL a sin (/) 
0 
0 


and J h2 (z) = ~~ = 
dz 


r r 
2 2 


(32) 


(33) 


The necessary and sufficient condition for the system Eq. 
(22) to be input-output linearized form and to be 
controllable is that the determinant of the following 
decoupling matrix Eq. (31) is not zero, det(<D d ) ^ 0 [8]. 


det(O d ) = - 


r 2 L 


2b 


(Bcos </> - Asm <f>) 

Va 2 +S 2 


(34) 
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where <P d is singular if the X 0 axis is perpendicular to 
the straight line. 

From Eqs. (29)-(31), the decoupling matrix is used to 
establish the input-output feedback linearization as shown 
below, 


y 2 


=^ > d z+ ^ > d u 


(35) 



r 3 (j hl s) i 


r a(j hl s) 1 

<3q 

where O d = 

a q 

dq 

= 


d(J h2 ). 


0 


dz 






2 x(n-m) 


Assuming that the condition det(<D d ) ^ 0 is satisfied and 
the transformation of state variables is a diffeomorphism, 
the auxiliary control input vector for achieving input- 
output linearization is given by 

u = © 1 [ n -© dZ ] (36) 

where z is the vector of wheels velocities; r\ e iR 2xl is 

defined as a new control input vector in the following 
form. 


k p e„ + k D e p +r' d 
K e v + i~d 


(37) 


where a tracking error vector with the position and linear 
velocity errors is defined as follows: 


e = 


i 

i_ 


i 

1 

A? 

i 

> 

_i 


i 

1 

A? 

_i 


(38) 


and k p , k D , k v are gains chosen to ensure the exponential 
convergence of the control errors to zero; rj, rj are 

reference shortest distance and reference linear velocity, 
respectively. 

The new control input vector r| with k p , k D , k v > 0 


makes the tracking error vector go to zero. 

Subtituting the auxiliary control input vector Eq. (36) into 
Eq. (35), a closed loop system can be obtained in the 
following two decoupled linearized form: 


A - 1\ 
% =*12 


or y = r\ 


(39) 


Eq. (39) are single input-single output systems with 
second-order of position control model and first-order of 
velocity control model. 

From Eqs. (37)-(39), the tracking error dynamics of the 
closed loop systems are given by 

e p + k D e p +k p e p =0 (40) 

e v +ky e v = 0 (41) 

which are exponentially stable [9]. 

The path-following control scheme is presented in Fig. 3. 
In Fig. 3, r d represents the desired values for the outputs, 


\ and h 2 . e is the error vector between the actual and 
the desired values. The control input vector Eq. (20) is 
applied so that the AGV dynamics state equation (19) is 
simplified into the form Eq. (21). This process is 
represented by the dotted block in Fig. 3. An auxiliary 
control input vector Eq. (36) designed with input-output 
linearization technique linearizes and decouples the 
overall system into two decoupled linearized subsystems, 
the position control subsystem and the velocity control 
subsystem as shown Eq. (39). The thick dashed block in 
Fig. 3 represents the global system plant with input- 
output linearization. The new control input vector Eq. 
(37) makes the tracking error vector go to zezo. 



IV. ERROR MESUREMENT AND HARDWARE 
1. Mesurement of tracking error using camera 

To achieve the controller, the errors have to be detected. 
The reference path is a straight line as a desired trajectory 
marked on a floor. A camera is mounted in front of the 
AGV to capture directly an image of the tracking line. 
The errors detecting scheme is shown in Fig. 4. 



Fig. 4: Errors detecting scheme 
The errors can be expressed by 

f <fr = arctan[(x A - x B ) / (y A - y B )] 

= (160-m x )cos^ 


(42) 


2. Hardware and Control System 

The configuration diagram of the total control system is 
shown in Fig. 5. The control system is based on the 
integration of notebook and PIC-based controller. The 
hardware of the system is composed of two-level control: 
the image processing control as high level computer 
control and the device control as low level 
microcontroller control. High-level image processing 
control algorithms are written in VC++ and run with a 
sampling time of 15 ms on the notebook (a Pentium IV- 
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2GHz processor). The notebook communicates with the 
PIC-based controller on the AGV through a COM port. 
For the operation, QuickCam SDK is used to capture the 
image stream into memory in bitmap format with size 
320pixel x 240pixel via a USB camera at speed of 30 
frames per seconds. The image is processed by VC++ 
program to extract the parameters of bounding box, center 
and direction of line. These parameters are used to 
determine oreintation angle and shortest distance as errors 
detecting scheme in Fig. 4. The input-output feedback 
linearization controller is designed to calculate the 
demand velocity of wheels. These demand torques are 
sent to the PIC-based controller to control the AGV 
motion. The tracked desired trajectory is shown on the 
computer interface of image processing in Visual C++ as 
shown in Fig. 6. 



Fig. 5: The configuration of control system 



Fig. 6: The tracked desired trajectory 

The configuration of the PIC-based controllers for the low 
level control is shown in Fig. 7. It consists of 
microcontrollers PIC18F452’s which are operated with 
the clock frequency 40MHz. The microcontroller 
performs three basis tasks: 1) communicating with the 
higher-level controller through RS232; 2) reading number 
of pulses from encoders; and 3) generating PWM duty 


cycle. The low level controller is composed of two parts: 
master controller and slave controller. The master 
controller functions as the low level control, that is, to 
receive demand velocities from the computer via RS232 
and, in turn, to send the commands to the two slave 
controllers via I2C communication, respectively. The 
slave controller integrates two PIC18F452’s with two 
motor drivers LMD18200 for the DC motor control. The 
sampling time of low level control system is about 10ms. 
The experimental AGV developed for this paper is shown 
in Fig. 8. 



Fig. 8: The experimental AGV 

V. SIMULATION AND EXPERIMENTAL 
RESULTS 

To verify the effectiveness of the proposed controller, 
simulations have been done for a AGV following a 
straight line. Fig. 9 shows that the desired trajectory is the 
straight line of 2.82 [raj.The straight line has the form of 

y = x. So the factors are A = 1, B = -1, C = 0. The 
desired linear velocity of AGV is r 2 = 0.05 [m / s] . The 
gains for the new control input vector are k p = 3.6 [s~ 2 ], 
k D =l.4[s~ 1 ], k v = 4.2 [s~ 1 ]. The input external 
disturbances are chosen to be random noises of mean 0 
with variance 0.7, and the upper bounds of disturbances 
are assumed as f™ = 1 [rad / s 2 ] and ff d = 1 [rad Is 2 ]. 
The numerical parameter values and the innital values for 
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simulation and experiment are given in Table 1 and Table 

2 . 



Table. 1: The numerical parameters values for simulation 
and experiment 


Parameters 

Values 

Units 

b 

0.39 

\m\ 

r 

0.16 

[m\ 

d 

0.45 

[m\ 

l 

1.2 

\m\ 

m c 

32.67 

[kg] 


2.75 

[kg] 

h 

17.85 

[kgm 2 ] 

K 

0.0135 

[kgm 2 ] 

4 

0.0068 

[kgm 2 ] 


Table. 2: The initial values for simulation and experiment 


x r 

0.2 [m] 

4 

0.32 [m] 

y r 

0.2 [m] 

y P 

0.24 [m] 

4>r 

45 [deg] 

</> 

30[deg] 

V P 

0 [mls] 

Reference 

inputs 

r'd =0 [m], 
rj =0.05 [m/s] 

4 

0.06 [m] 

Sampling 

time 

AT = 0.01 [s] 


The simulation and experimental results for path¬ 
following are shown in Figs. 10 to 17. Figs. 10 and 11 
show the movement of the AGV along the desired 
trajectory for full time 40 seconds and the beginning time. 
As shown in Fig. 12, the tracking point P a of the AGV is 
able to reach the straight line path and stay on the path for 
full time. Fig. 13 shows that the linear velocity of the 
AGV is at the vicinity of 0.05 [mls] as desired. The 
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experimental position error e p and the experimental 
linear velocity error e v converge to zero and are bounded 
along the simulation result as shown in Figs. 14 and 15. 
The angular velocities of left and right wheel are shown 
in Fig. 16. It shows that the angular velocities of left and 
right wheels change quickly at the beginning time and 
have same value about 0.32 [rad / s] for following the 
straight line from about 7 seconds. Fig. 17 shows the 
control input vector x. They change greatly at the 
beginning time. However, they are bounded within the 
bounds of ±7.6 [ N.m ] and their average value converges 

to zero when AGV moves along the desired trajectory 
after 4 seconds. The above simulation and experimental 
results are presented to illustrate the effectiveness of the 
proposed control algorithm. 
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Fig. 12: Shortest distance h± 



Fig. 13: Linear velocity of the AGV for full time 



Fig. 14: Simulation and experimental position error 
results e p 
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Fig. 15: Simulation and experimental linear velocity 
error results e v 



Fig. 16: Angular velocities of the right and left wheels 



VI. CONCLUSION 

In this paper, a path-following controller is proposed 
based on the dynamic model of AGV under uncertainties 
and external disturbances using input-output feedback 
linearization method. Using the input-output feedback 
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linearization technique, two decoupled linearized SISO 
system are obtained: a second-order position model, and a 
first-order velocity model. A new control input vector is 
chosen to make the tracking error vector go exponentially 
to zero. To implement the proposed controller, a control 
system is developed based on PIC microcontroller and 
USB camera. The simulation and experimental results are 
presented to illustrate the good applicability to AGV of 
the proposed control algorithm. 
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